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Mindstorms, the by now well-known series of robot construction materials from 


Lego, has already been the subject of several articles in Elektor Electronics. In 


2000, we presented a series of five articles dealing with all the ins and outs of 


the RCX module, which is a microcontroller block with three sensor inputs and 


three outputs for controlling items such as motors and lamps. Following this 


came a light sensor, a proximity sensor and a sensor multiplexer, and recently 


a design for an I2C interface appeared in our magazine. This month it’s time for 


a compass sensor, which enables us to give our robots a sense of direction. 


If a robot has to travel through a space, this 
can be implemented in a variety of manners. 
The first option is to allow the robot to search 
out its own path. Proximity and contact sen- 
sors allow the robot to independently avoid 
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obstacles in order to prevent dam- 
age and/or prevent the robot from 
ending up in a situation that it can- 
not get out of on its own. The Mind- 
storms package includes the sensors 


that we need for this approach. 

A second option is to give the 
robot an objective: to allow it to inde- 
pendently find a way to reach a pre- 
viously specified location. One exam- 
ple is following a line that defines the 
course to be taken, such as the one 
on the mat included in this Lego box. 

The route can also be defined in 
the RCX module by energising the 
robot’s motors for defined intervals 
and calculating the path that has 
been travelled during these inter- 
vals. The disadvantage of this 
method is that the speed of the 
motors depends on the voltage of the 
RCX battery. In the course of time, 
the motors will turn more slowly. 
This causes a gradual decrease in 
the accuracy of position determina- 
tion. A compass is an excellent 
means to at least measure the direc- 
tion in which the robot is moving, in 
order to allow the robot to determine 
its orientation and modify it as nec- 
essary. In this article, we describe a 
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Figure |. The circuit diagram consists of four analogue switches, a few passive components and a Pewatron type 6945 compass sensor. 


simple manner to equip a Mind- 
storms robot with a compass. 


Our design uses a Pewatron type 
6945 digital compass sensor. This is 
not the first time that this sensor has 
been used in an Elektor Electronics 
project, since in September 1996 we 
presented an electronic compass 
that also uses the 6945. The sensor 
contains a miniature rotor, a magnet 
and a special Hall-effect IC, which 
are used together to determine its 
orientation with respect to the 
earth's magnetic field. The four digi- 
tal outputs, of which two can be 
simultaneously active, provide a res- 
olution of 45 degrees for determining 
the sensor orientation. It should be 
noted that the sensor must be 
aligned perpendicular to the surface 
of the earth and that external mag- 
netic fields can significantly disturb 
the measurement. At a price of 
around €50 (approx. £30), the 6945 is 
not exactly cheap, so it should be 
handled as carefully as possible. 


The circuit 


The circuit diagram of our RCX com- 
pass is shown in Figure 1. The cir- 
cuit that provides the interface 
between the sensor and the RCX 
module is powered from the RCX 
module. As you probably know, the 
RCX can power a sensor and make 
measurements on the same sensor 
using only two leads (see Figure 1). 
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Most of the time, the supply voltage 
is present on the A and B terminals. 
During short intervals, the supply 
voltage is switched off and a mea- 
surement is made. During the mea- 
surement interval, the interruption in 
the supply voltage is bridged by 
electrolytic capacitor C1. Diode 
bridge D1-D4 ensures that terminals 
A and B can be swapped without 
causing any problems. During the 
measurement interval, diodes D5 
and D6 play a comparable role in 
determining the resistance of the cir- 
cuit connected to the RCX input. 

The actual sensor, the 6945, 
draws a fairly large current (20 mA) 
and is thus powered by the 9-V bat- 
tery Bt1, since the sensor terminals 
of the RCX module can supply a 
maximum current of only 10 mA and 
would otherwise be overloaded. 
Diode D7 protects the sensor against 
a reversed-polarity supply voltage. 

The 6945 has four open-collector 
outputs, of which two are concur- 
rently active (Low), depending on the 
orientation of the sensor. The pull-up 
resistors R5-R8 adapt the voltage 
levels at the sensor outputs to the 
supply voltage of the interface circuit, 
which as previously mentioned is 
powered by the RCX module. 

The four outputs of the 6945 drive 
the four analogue switches of IC1, 
which in turn cause a certain combi- 
nation of resistors R1-R4 to be con- 
nected in parallel to the RCX sensor 
input. Table 1 shows the values mea- 


sured by the RCX module, depending on the 
orientation of the sensor. Here we see eight 
compass directions as a function of the state 
of the compass sensor. Note that only a small 
portion of the measurement range of the RCX 
is used, but this is adequate for determining 
the eight states of the sensor with sufficient 
accuracy (the RCX can determine a measure- 
ment value between 0 and 1023 at its input). 

It would have probably been possible to 
connect resistors R1-R4 directly to the out- 
puts of the sensor, which would allow IC1 
and R5-R8 to be eliminated. However, con- 
sidering the price of the sensor and the fact 
that the sensor data sheet is very skimpy and 
gives hardly any information about the load 
capacity of the outputs, we decided we 
would rather be safe than sorry. 


Construction 


If you want to have a truly compact sensor, 
you best bet is to build the circuit on a piece 


Table I. 


Recommended values for resistors 
RI-R4 


Direction sensor pin RCX value 
3 6 9 12 
N I | t O0 863 
NO Oo ! tt Oo 920 
O Oo ! It J 810 
ZO 0O O ! | 856 
Z | @ it J] 818 
ZW 1 0 O0 | 830 
W I ot @ 787 
NW I | 0 0 887 
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Figure 2. In order to keep the circuit board small, the resistors and diodes are fitted vertically. Note the wire bridges next to the sensor! 
(board not available ready-made). 


of perforated prototyping board in order to 
keep the dimensions of the circuit as small as 
possible. However, if you would like a bit 
more convenience and are not all that worried 
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-SelectPrgm SLOT3 
-BeginOfTask MAIN 
-SetSensorType SENSOR_2, LIGHT _TYPE 


With RCX 

-ComPortNo = 1 ‘ COM port 1 

-LinkType = 0 ‘0 = IR 

»PBrick = 1 ‘ 1 = RCX, 0 = CyberMaster 
-InitComm á 


about size, you can use the circuit 
board layout shown in Figure 2. Pay 
attention to the wire bridges next to 
the sensor, especially the short wire 


Listi ng l. Sample program in Visual Basic. 


Private Sub Command1_Click() 
Const setpoint = 5 

Const measure = 6 

Const dif = 7 


Initialise the COM port 


-SetSensorMode SENSOR_2, RAW MODE, 0 


-SetVar setpoint, CON, 1 
-SetVar measure, CON, 0 
-SetVar dif, CON, 0 


-StartTask 1 


-EndOfTask ‘Main 


-BeginOfTask 1 
-Loop CON, forever 
‘North 


-If SENVAL, SENSOR 2, EQ, CON, 
-SetVar measure, CON, 1 

-EndIf 

.If SENVAL, SENSOR_2, EQ, CON, 
.SetVar measure, CON, 1 

-EndIf 

.If SENVAL, SENSOR_2, EQ, CON, 
-SetVar measure, CON, 1 

-EndIf 


‘North-East 


.If SENVAL, SENSOR_2, EQ, CON, 
.SetVar measure, CON, 2 

-EndIif 

-If SENVAL, SENSOR_2, EQ, CON, 
-SetVar measure, CON, 2 

-EndIif 

-If SENVAL, SENSOR_2, EQ, CON, 
-SetVar measure, CON, 2 

-EndIf 


863 


862 


920 


‘1=N,2=NE,3=E,4=SE,5=S, 6=SW, 7=W, 8=NW 


bridge under the middle of the sen- 
sor. The best approach is to use insu- 
lated wire for these bridges and fit 
them to the copper side of the board, 
since this allows the sensor to be fit- 
ted flush to the surface of the board. 

For connecting the sensor to the 
RCX module, we use a standard 
Lego cable with terminal bricks, 
which we cut in two. The battery 
should be mounted as far away from 
the sensor as possible, since other- 
wise the metal case of the battery 
will affect the reading. 


Software 


The sample program (see Listing 1) 
for using our compass sensor is writ- 
ten in Visual Basic. When the soft- 
ware provided on the Mindstorms 
CD is installed, the SPIRIT.OCX soft- 
ware library is also installed. This 
library allows the RCX to be pro- 
grammed and controlled using this 
high-level language. The listing can 
also be used with other languages, 
such as Delphi or C++, without 
major modifications. 

Starting with a blank form in 
Visual Basic, we place a Spirit con- 
trol and a Command button on it. A 
double click on this button opens a 
window into which we can copy 
Listing 1. When we execute the 
Visual Basic program, the applica- 
tion is sent to the RCX block via the 
Tower. 

The sample program is reason- 
ably simple. In the program, a direc- 
tion is specified in the line SETVAR 
setpoint, CON, 1. The latter number 
can be assigned a value from 1 to 8 
in order to set the desired direction. 
Following this, the value of the sen- 
sor is read using an infinite loop. If 
the orientation matches the previ- 
ously set direction, a tone is emitted 
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GENERAL INTEREST 


COMPONENTS LIST ‘East 


.If SENVAL, SENSOR_2, EQ, CON, 810 
-SetVar measure, CON, 3 


Resistors: eee 

RISK .If SENVAL, SENSOR_2, EQ, CON, 809 
R2,R5-R8 = 100kQ .SetVar measure, CON, 3 

R3 = 150kQ .EndIf 

R4 = 220kQ 


.If SENVAL, SENSOR_2, EQ, CON, 808 
-SetVar measure, CON, 3 
Capacitors: -EndIf 
CI = 22uF l6V radial ‘South-East 

.If SENVAL, SENSOR_2, EQ, CON, 856 
Semiconductors: -SetVar measure, CON, 4 


DI-D6 = IN4148 -EndIf 
D7 = BAT85 .If SENVAL, SENSOR_2, EQ, CON, 855 


ICI = 74HCT4066 .SetVar measure, CON, 4 
-EndIf 
.If SENVAL, SENSOR_2, EQ, CON, 854 


Miscellaneous: .SetVar measure, CON, 4 





Sensor| = Pewatron 6945 (Pewa- EndIf 
tron AG, www.pewatron.com) 1South 

BTI = 9V PP3 battery with clip-on .If SENVAL, SENSOR_2, EQ, CON, 818 
lead .SetVar measure, CON, 5 

Lego connection cable (cut in -EndIf 
two): .If SENVAL, SENSOR_2, EQ, CON, 817 


length 26.6cm, Lego order code -Setvar measure, CON, 5 
5311 .EndIf 


.If SENVAL, SENSOR_2, EQ, CON, 816 
-SetVar measure, CON, 5 
. EndIf 
‘South-West 
.If SENVAL, SENSOR_2, EQ, CON, 830 


length 9cm, Lego order code 5041 


by the RCX buzzer. .SetVar measure, CON, 6 
The four lines following the state- -EndIf 
ment With RCX are related to the .If SENVAL, SENSOR_2, EQ, CON, 829 
i x -SetVar measure, CON, 6 
communications between the PC EndIf 


and the RCX module. They have no 
direct significance for the actual 
application. Following this, program -EndIf 

slot 3 in the RCX module is selected. mest P 3 ae 
After this, sensor 2 is configured in E ee ee te cena” 


.If SENVAL, SENSOR_2, EQ, CON, 828 
-SetVar measure, CON, 6 


the task Main so we can work with 
the compass sensor, the desired 
direction is selected (setpoint) and 
the registers for storing the mea- 
sured value (measure) and the differ- 
ence between the measured and tar- 
get values (dif) are set to zero. The 
final statement in Main starts task 1, 
which contains the infinite loop. 
When a measurement is made, 
three values are checked for each 
direction in order to compensate for 
any variations that may be present. 
If the measured value actually falls 
within the range of a particular com- 
pass direction, the measure register 
receives a value equal to the 
sequence number of this direction. 
After these 24 comparisons with 
the measured value have been 
made, a check is made to see 


-SetVar measure, CON, 7 


.- EndIf 


.If SENVAL, SENSOR_2, EQ, CON, 786 
-SetVar measure, CON, 7 


.- EndIf 


.If SENVAL, SENSOR_2, EQ, CON, 785 
-SetVar measure, CON, 7 


- EndIf 
‘North-West 


.If SENVAL, SENSOR_2, EQ, CON, 887 
-SetVar measure, CON, 8 


-EndIf 


.If SENVAL, SENSOR_2, EQ, CON, 886 
-SetVar measure, CON, 8 


.- EndIf 


.If SENVAL, SENSOR_2, EQ, CON, 885 
-SetVar measure, CON, 8 


- EndIf 


‘The sensor value 
‘the target value 
-SetVar dif, VAR, 
-SubVar dif, VAR, 
.If VAR, dif, EQ, 


is stored in register ‘measure’ 
in ‘setpoint’ 

measure ‘dif=measure-setpoint 
setpoint 

CON, 0 


-PlaySystemSound 0 


-EndIf 
whether the measured direction .EndLoop 
matches the set direction. If this is odon hai 
the case (dif=0), routine Playsystem- mael lia 
sound is executed. End Sub 


(010111-1) 
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